arm: mx6: cm_fx6: implement board specific sata stop

Provide board specific implementation for sata stop command for
cm_fx6.

Signed-off-by: Nikita Kiryanov <[email protected]>
Cc: Stefano Babic <[email protected]>

diff --git a/board/compulab/cm_fx6/cm_fx6.c b/board/compulab/cm_fx6/cm_fx6.c
index 0206ae81fca771672cea01d29df53571096ef8a1..09e285b74db81b34e4e32790cd06887f786fb7dd 100644 (file)
--- a/board/compulab/cm_fx6/cm_fx6.c
+++ b/board/compulab/cm_fx6/cm_fx6.c
@@ -98,9 +98,6 @@ int sata_initialize(void)
        /* Make sure this gpio has logical 0 value */
        gpio_direction_output(CM_FX6_SATA_PWLOSS_INT, 0);
        udelay(100);
-
-       cm_fx6_sata_power(0);
-       mdelay(250);
        cm_fx6_sata_power(1);
 
        for (i = 0; i < CM_FX6_SATA_INIT_RETRIES; i++) {
@@ -125,6 +122,15 @@ int sata_initialize(void)
 
        return err;
 }
+
+int sata_stop(void)
+{
+       __sata_stop();
+       cm_fx6_sata_power(0);
+       mdelay(250);
+
+       return 0;
+}
 #else
 static int cm_fx6_setup_issd(void) { return 0; }
 #endif